#include "sha256.h"
#include <stdbool.h>
#include <stdio.h>
#include <stdlib.h>
uint32_t K[] = {
            0x428a2f98, 0x71374491, 0xb5c0fbcf, 0xe9b5dba5,
            0x3956c25b, 0x59f111f1, 0x923f82a4, 0xab1c5ed5,
            0xd807aa98, 0x12835b01, 0x243185be, 0x550c7dc3,
            0x72be5d74, 0x80deb1fe, 0x9bdc06a7, 0xc19bf174,
            0xe49b69c1, 0xefbe4786, 0x0fc19dc6, 0x240ca1cc,
            0x2de92c6f, 0x4a7484aa, 0x5cb0a9dc, 0x76f988da,
            0x983e5152, 0xa831c66d, 0xb00327c8, 0xbf597fc7,
            0xc6e00bf3, 0xd5a79147, 0x06ca6351, 0x14292967,
            0x27b70a85, 0x2e1b2138, 0x4d2c6dfc, 0x53380d13,
            0x650a7354, 0x766a0abb, 0x81c2c92e, 0x92722c85,
            0xa2bfe8a1, 0xa81a664b, 0xc24b8b70, 0xc76c51a3,
            0xd192e819, 0xd6990624, 0xf40e3585, 0x106aa070,
            0x19a4c116, 0x1e376c08, 0x2748774c, 0x34b0bcb5,
            0x391c0cb3, 0x4ed8aa4a, 0x5b9cca4f, 0x682e6ff3,
            0x748f82ee, 0x78a5636f, 0x84c87814, 0x8cc70208,
            0x90befffa, 0xa4506ceb, 0xbef9a3f7, 0xc67178f2
};
uint32_t H0[] = {
            0x6a09e667, 0xbb67ae85, 0x3c6ef372, 0xa54ff53a,
            0x510e527f, 0x9b05688c, 0x1f83d9ab, 0x5be0cd19
};
void calc_sha256(uint32_t* in,int blocknum,uint32_t* out){
    uint32_t H[8]={H0[0],H0[1],H0[2],H0[3],H0[4],H0[5],H0[6],H0[7]};
    uint32_t w[64];
    for(int i=0;i<blocknum;++i){
        printf("sha256 mainloop:%d\n",i);
        uint32_t* block_start=in+64*i;
        for(int j=0;j<16;++j){
            w[j]=B(*(block_start+j));
        }
        for(int j=16;j<64;++j){
            w[j]=sigma1(w[j-2])+w[j-7]+sigma0(w[j-15])+w[j-16];
        }
        for(int i=0;i<16;++i){
            printf("w[%d]-w[%d]:%08x %08x %08x %08x\n",i*4,i*4+3,w[i*4],w[i*4+1],w[i*4+2],w[i*4+3]);
        }
        uint32_t a=H[0],b=H[1],c=H[2],d=H[3],e=H[4],f=H[5],g=H[6],h=H[7];
        
        for(int j=0;j<64;++j){
            printf("l%d:%08x %08x %08x %08x %08x %08x %08x %08x\n",j,a,b,c,d,e,f,g,h);
            uint32_t T1=h+SIGMA1(e)+CH(e,f,g)+K[j]+w[j];
            uint32_t T2=SIGMA0(a)+MAJ(a,b,c);
            h=g;
            g=f;
            f=e;
            e=d+T1;
            d=c;
            c=b;
            b=a;
            a=T1+T2;
        }
        H[0]+=a;
        H[1]+=b;
        H[2]+=c;
        H[3]+=d;
        H[4]+=e;
        H[5]+=f;
        H[6]+=g;
        H[7]+=h;
    }
    out[0]=H[0];
    out[1]=H[1];
    out[2]=H[2];
    out[3]=H[3];
    out[4]=H[4];
    out[5]=H[5];
    out[6]=H[6];
    out[7]=H[7];
}
uint32_t* expand(char* in,uint64_t size){
    uint64_t arr_size=(size+9)/64+(size+9)%64?1:0;
    arr_size*=64;
    printf("expand:arr_size=%d\n",arr_size);
    void *tmp=malloc(arr_size);
    uint8_t* ctmp=tmp;
    for(int i=0;i<size;++i){
        ctmp[i]=in[i];
    }
    ctmp[size]=(uint8_t)0x80;
    *((uint32_t*)(ctmp+arr_size-4))=B((uint32_t)size*8);
    printf("expanded:\n");
    for(int i=0;i<arr_size;++i){
        printf("%02x",ctmp[i]);
    }

    printf("\nexpand end!\n");
    return tmp;
}

